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Stability and Performance Limits of Latency-Prone 
Distributed Feedback Controllers 

Y. Zhao, N. Paine, K.S. Kim, and L. Sends* 


Abstract —Robotic control systems are increasingly relying on 
distributed feedback controllers to tackle complex sensing and 
decision problems such as those found in highly articulated 
human-centered robots. These demands come at the cost of a 
growing computational burden and, as a result, larger controller 
latencies. To maximize robustness to mechanical disturbances by 
maximizing control feedback gains, this paper emphasizes the 
necessity for compromise between high- and low-level feedback 
control effort in distributed controllers. Specifically, the effect 
of distributed impedance controllers is studied where damping 
feedback effort is executed in close proximity to the control 
plant and stiffness feedback effort is execnted in a latency- 
prone centralized control process. A central observation is 
that the stability of high impedance distributed controllers is 
very sensitive to damping feedback delay but much less to 
stiffness feedback delay. This study pursues a detailed analysis 
of this observation that leads to a physical understanding of 
the disparity. Then a practical controller breakdown gain rule 
is derived to aim at enabling control designers to consider 
the benefits of implementing their control applications in a 
distributed fashion. These considerations are further validated 
through the analysis, simulation and experimental testing on high 
performance actuators and on an omnidirectional mobile base. 

Index Terms —Distributed Feedback Control, High Impedance 
Control, Feedback Delays, Mobile Robotics. 

I. Introduction 

As a result of the increasing complexity of robotic control 
systems, such as human-centered robots IHIIZI and industrial 
surgical machines E, new system architectures, especially 
distributed control architectures nnia, are often being sought 
for communicating with and controlling the numerous de¬ 
vice subsystems. Often, these distributed control architectures 
manifest themselves in a hierarchical control fashion where a 
centralized controller can delegate tasks to subordinate local 
controllers (Figure[2l. As it is known, communication between 
actuators and their low-level controllers can occur at high rates 
while communication between low- and high-level controllers 
occurs more slowly. The latter is further slowed down by 
the fact that centralized controllers tend to implement larger 
computational operations, for instance to compute system 
models or coordinate transformations online. 

A. Control architectures with feedback delays 

One concern is that feedback controllers with large delays, 
such as the centralized controllers mentioned above, are less 
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a) Centralized Control b) Decentralized Control 



Fig. 1: Depiction of Various Control Architectures. Many 
control systems today employ one of the control architectures 
above: a) Centralized control with only high-level feedback 
controllers (HLCs); b) Decentralized control with only low- 
level feedback controllers (LLCs); c) Distributed control with 
both HLCs and LLCs, which is the focus of this paper. 

stable than those with small delays, such as locally embed¬ 
ded controllers. Without the fast servo rates of embedded 
controllers, the gains in centralized controllers can only be 
raised to limited values, decreasing their robustness to external 
disturbances a and unmodelled dynamics miisi. 

As such, why not removing centralized controllers alto¬ 
gether and implementing all feedback processes at the low- 
level? Such operation might not always be possible. For 
instance, consider controlling the behavior of human-centered 
robots (i.e. highly articulated robots that interact with humans). 
Normally this operation is achieved by specifying the goals 
of some task frames such as the end effector coordinates. 
One established option is to create impedance controllers on 
those frames and transform the resulting control references to 
actuator commands via operational space transformations E). 
Such a strategy requires the implementation of a centralized 
feedback controller which can utilize global sensing data, 
access the state of the entire system model, and compute 
the necessary models and transformations for control. Because 
of the aforementioned larger delays on high-level controllers, 
does this imply that high gain control cannot be achieved in 
some human centered robot control due to stability problems? 
It will be shown that this may not need to be the case. But for 
now, this delay issue is one of the reasons why various cur¬ 
rently existing human-centered robots cannot achieve the same 
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level of control accuracy that it is found in high performance 
industrial manipulators. More concretely, this study proposes 
a distributed impedance controller where only proportional 
(i.e., stiffness) position feedback is implemented in the high- 
level control process with slow servo updates. This process 
will experience the long latencies found in many modern 
centralized controllers of complex human-centered robots. At 
the same time, it contains global information of the model 
and the external sensors that can be used for operational space 
control. For stability reasons, our study proposes to implement 
the derivative (i.e., damping) position feedback part of the 
controller in low-level embedded actuator processes which can 
therefore achieve the desired high update rates. 

B. Analysis of sensitivity to delay 

To focus the study on the physical performance of the 
proposed distributed control approach, our study first focuses 
on a single actuator system with separate stiffness and damp¬ 
ing servos and under multiple controller delays. Then the 
physical insights gained are used as a basis for achieving 
high impedance behaviors in single actuator systems and in an 
omnidirectional mobile base. Let us pose some key questions 
regarding distributed stiffness-damping feedback controllers 
considered in this paper: (A) Does controller stability have 
different sensitivity to stiffness and damping feedback delays? 
(B) If that is the case, what are the physical reasons for such a 
difference? (C) In applications where load uncertainty exists, 
how robust is the distributed controller to these uncertainties? 

To answer these questions, this paper studies the physical 
behavior of the proposed realtime distributed system using 
control analysis tools applied to the system’s plant, including 
the phase margin stability criterion and time-based trajectory 
tracking response. Using these tools our study reveals that 
system stability and performance are much more sensitive to 
damping feedback delays than to stiffness feedback delays. 

C. Benefits of the proposed distributed control architecture 

As it will be empirically demonstrated, the benefit of the 
proposed split control approach over a monolithic controller 
implemented at the high-level is to increase control stability 
due to the reduced damping feedback delay. As a direct result, 
closed-loop actuator impedance may be increased beyond 
the levels possible with a monolithic high-level impedance 
controller. This conclusion may be leveraged on many practical 
systems to improve disturbance rejection by increasing gains 
without compromising overall controller stability. As such, 
these hndings are expected to be immediately useful on many 
complex mechatronic and control systems. 

To demonstrate the effectiveness of the proposed methods, 
this study implements two types of tests on a high performance 
actuator followed by experiments on a mobile base. First, a 
position step response is tested on an actuator under various 
combinations of stiffness and damping feedback delays. The 
experimental results show high con'elation to their cotTespond- 
ing simulation results. Second, trajectory tracking performance 
of a complex joint trajectory with load uncertainty is tested 
both in simulation and in hardware on the same actuator. 



Fig. 2: Actuator and Control Plant Model. This diagram 
represents a generalization of rigid actuators considered in 
this paper. Fm is the applied motor force, x is the load 
displacement output, m is effective output inertia, b is the 
actuator’s passive damping, and Fd is an external disturbance 
force. 

Third, the proposed distributed controllers is leveraged an 
implementation into an omnidirectional base. The results show 
a substantial increase in closed-loop impedance capabilities, 
which results in higher tracking accuracy with respect to the 
monolithic centralized controller counterpart approach. 

II. Related Work 

Advances in distributed control technologies 15] [TOl have 
enabled the development of decentralized multi input and 
multi output systems such as humanoid systems and highly 
articulated robots m El. However the effect on controller 
performance due the ever growing computational demand on 
feedback servos and latency-prone serial communications in 
human-centered robots have been largely overlooked on these 
studies. 

Distributed control architectures in robotics combine cen¬ 
tralized processes with self-contained control units in close 
proximity to actuators and sensors. Two inherent advantages 
of having low level processes are: 1) to increase computational 
resources by offloading the workload of the central computer 
onto distributed processors 11 and 2) to increase control 
system stability and tracking performance due to reduced 
feedback delays. This study focuses on the latter advantage, 
i.e., how a distributed controller improves control system sta¬ 
bility and performance over monolithic centralized control ap¬ 
proaches. A detailed analysis, exploration, and implementation 
of the high impedance capabilities of distributed controllers 
for a mobile base with latency-prone centralized processors 
has not previously been performed. 

Robustness and the effects of delay have often been studied 
in work regarding Proportional-Integral-Derivative (PID) con¬ 
troller tuning. A survey of PID controllers including system 
plants using phase margin techniques with linear approxima¬ 
tions is conducted in m. The works MM study auto¬ 
tuning and adaption of PID controllers while the work ifTSl 
furthers these techniques by developing optimal design tools 
applied to various types of plants including delays. The study 
in ifThl proposed an optimal gain scheduling method for DC 
motor speed control with a PI controller. In ini, a back- 
stepping controller with time-delay estimation and nonlinear 
damping is developed for variable PID gain tuning under 
disturbances. The high volume of studies on PID tuning 
methods highlight the importance of this topic for robust 
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Fig. 3: Single Input / Single Output Controller with Distributed Structure. A simple proportional-derivative control law is 
used to control an actuator. P denotes the actuator plant with motor current input, iM, and position output, x. represents 
a scaling constant mapping the desired force, F^, to the motor current, iM- K is the stiffness feedback gain while B is 
the damping feedback gain. The damping feedback loop is labeled as embedded to emphasize that it is meant to be locally 
implemented to take advantage of high servo rates. On the other hand the stiffness loop is implemented in a high-level 
computational process close to external sensors and centralized models, for operational space control purposes. Operational 
space control is normally used in human-centered robotic applications where controllers use task coordinates and global models 
for their operation. An external disturbance is denoted as inserted between the controller and plant block as suggested by 
HD. This simple controller is used to illustrate the discrepancies to latencies between the servo loops. It does not correspond 
to a practical robot controller as it contains only a single degree of freedom. After studying the physical advantages of these 
type of structure, we leverage it to a multi-axis robotic base shown in Figure [T^ demonstrating the ability to decouple the 
damping and stiffness servos to simultaneously achieve system stability and operational space control. 


control under disturbances. However, none of those studies 
considers the sensitivity discrepancy to latencies between the 
stiffness and damping servos as separate entities nor do they 
consider the decoupling of those servos into separate processes 
for stability purposes as it is done in this paper. 

The field of haptics ifTSll . networked control lfT9l l20l and 
teleoperation m have also thoroughly studied delays and 
filtering effects. Specifically, haptics is more related to our 
work because it is a special case of distributed control in 
which the master and slave devices require separate feedback 
controllers. Due to the destabilizing effects of time delays, 
significant effort has been put forth to ensure systems are 
stable by enforcing passivity criteria HH. Other works ED- 
l23l further relax this constraint and focus on how delay and 
filtering affect stability. Related work has been performed 
considering additional real-world effects such as quantization 
and coulomb friction on system stability ED. Once more, 
theses studies do not analyze nor exploit the large sensitivity 
discrepancy between stiffness and damping feedback loops 
nor propose solutions to increase performance based on this 
discrepancy. 

Consequently, our main contribution is to analyze, provide 
control system solutions, implement and evaluate actuators 
and mobile robotic systems with latency-prone distributed 
architectures to significantly enhance their trajectory tracking 
capabilities under disturbances and system uncertainties. In 
particular, a new study is performed to reveal that system 


stability and performance is more sensitive to damping servo 
latencies than stiffness servo latencies. Then a novel servo 
breakdown rule is proposed to evaluate the benefits of using a 
distributed control architecture. As a conclusion, this paper 
proposes to use stiffness servos for centralized operational 
space control while realizing embedded-level damping servos 
as joint space damping processes for stability and tracking 
accuracy. 

III. Basic Distributed Control Structure 
T his section describes the actuator model used to analyze 
closed-loop system stability, propose a basic distributed con¬ 
trol architecture that delocalizes stiffness and damping servo 
loops, and analyzes the sensitivity of these control processes 
to loop delays. 

A. Actuator plant model 

Many rigid electrical actuators like the ones used in modern 
robots can be approximately modeled as a second-order plant 
with a force acting on an inertia-damper pair (Figure |^. 
Considering a current-controlled motor, the control plant from 
current, im, to position, x, is 

^ ^ ^m{s) ^ V 

iM{s) Fm{s) iM{s) 

where Fm is the applied motor force, v = Fm/Im = pNkr, 
f] is the drivetrain efficiency, N is the gear speed reduction 
and k-T is the motor torque constant. 
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B. Closed-loop distributed controller model 

Figure shows our proposed distributed controller built 
using a proportional-derivative feedback mechanism. It in¬ 
cludes velocity feedback bitering {Qys), stiffness feedback 
delay (Tg), damping feedback delay (T^), with Tg ^ Td, 
stiffness feedback gain (K) and damping feedback gain (B). 
Excluding the unknown load (Fd), the desired motor force 
(Fjy) in the Laplace domain associated with the proposed 
distributed controller is 


Fo{s) = K{xD-e ->r B{xds - e ’^‘^''QyXs), (2) 


where s is the Laplace variable, xd and xd (i.e., xdS in the 
Laplace domain) are the desired output position and velocity, 
and 6“^” ® and ® represent Laplace transforms of the 
time delays in the stiffness and damping feedback loops, 
respectively. Using the above equation and Equation ([T]i, one 
can derive the closed-loop transfer function from desired to 
output positions as 


p ( ) ^ JL = _ Bs-\-K _ 

^ xjj ms^{be~'^'^^BQy)s 


(3) 


where Qy is chosen to be a brst order low pass biter with a 
cutoff frequency fy 


Qv{s) 


27r/„ 
s -I- 27r/„ 


(4) 


To derive the open-loop transfer function CD of the dis¬ 
tributed controller, one can re-write Equation ([^ as 


Pcl{s) 


Bs+K 

ms‘^-\-bs 


1 + Pol{s)’ 


(5) 


where Pol{s) = P{s)F[{s) is the open-loop transfer function. 


Pods) 


e ^•^‘^BQyS e 
ms^ -f bs 


( 6 ) 


P(s) is the actuator’s plant, and F[{s) is the so-called feedback 
transfer function. 

The presence of delays and bitering causes the above closed 
loop plant to behave as a high order dynamic system for which 
typical gain selection methods do not apply. However, to make 
the problem tractable, one can debne a dependency between 
the stiffness and damping gains using an idealized second 
order characteristic polynomial CD 


-f 2C,i0nS -f 


(7) 


where is the so-called natural frequency and C, is the so- 
called damping factor. In such case, the idealized characteristic 
polynomial (i.e. ignoring delays, Tg = Td = 0, and bitering, 
Qy = 1) associated with our closed loop plant of Equation ([^ 
would be 

s'^{B-\-b)/'m ■ sK/m. (8) 


Choosing the second order critically damped rule, ^ = 1 
and comparing Equations Q and ([^ one can get the gain 
dependency 

(9) 


Varying Stiffness Feedback Delays (Td = 3 ms, fv = 50 Hz) 



Varying Damping Feedback Delays (Ts = 3 ms, fv = 50 Hz) 



Eig. 4; Phase Margin Sensitivity to Loop Delays. This bgure 
shows phase margin simulations of the open loop transfer 
function shown in (|^ as a function of the natural frequency 
debned in (lOi and the servo delays shown in Eigure A 
phase margin of 0° is considered unstable, however, from 
simulations of various types of actuators 123 , oscillatory 
behavior begins below the threshold of 50°, displayed above 
as a horizontal line. Delays ranging between 1 ms and 5 
ms are simulated for both the stiffness and damping servos. 
The simulations are performed based on identical actuator 
parameters than those used in the experimental section. Section 
[V] i.e. passive output inertia m = 256 kg and passive damping 
b — 1250 Ns/m. Equations (j^ and (lOi can subsequently be 
used to derived the stiffness and damping feedback gains. The 
key observation here is that variations of the phase margin 
curves above are much more pronounced from damping servo 
delays than from stiffness servo delays. 


and the natural frequency. 


In 


A 



( 10 ) 


The second order dependency of Equation (j^ will be used for 
the rest of this paper for deriving new gain selection methods 
through the thorough analysis of the oscillatory behavior of the 
closed loop plant of Equation ([^l. In particular our study will 
use the phase margin criterion and other visualizations tools 
to study how the complete system reacts to feedback delays 
and signal bitering. Phase margin is the additional phase value 


B = 2 dmK - b, 
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above —180° when the magnitude plot crosses the 0 dB line 
(i.e., the gain crossover frequency). It is common to quantify 
system stability by its phase margin. 


C. Phase margin sensitivity comparison 

This subsection focuses on utilizing frequency domain 
control method to analyze the phase margin sensitivity to 
time delays on the distributed control architecture shown on 
Figure Different delay range scales are considered; (1) a 
small range scale (1 — 5 ms) to show detailed variations, 
and (2) a larger range scale (5 — 25 ms) to cover practical 
control ranges. These scales roughly correspond to embedded 
and centralized computational and communication processes 
found in highly articulated robots such as ll26l . Phase margin 
plots, are subsequently obtained for the controller of Equa¬ 
tion ([^ and shown on Figures andj^as a function of the 
natural frequency given in Equation ( [10| and using the gain 
relationship of Equation (j^. 

From Figure it is noticeable that reducing either stiffness 
or damping feedback delays will increase the stability of 
the controller. But more importantly, it is clearly visible that 
phase margin behavior is much more sensitive to damping 
servo delays (Td) than to stiffness servo delays (Tg). Not 
only there is a disparity on the behavior with respect to 
the delays, but phase margin is fairly insensitive to stiffness 
servo delays in the observed time scales. Such disparity and 
behavior is the central observation that motivates this paper 
and the proposed distributed control architecture. Figure 
simulates step position response of the controller for a range 
of relatively large stiffness delays and for two choices of 
damping delays, a short and a long one. It becomes clear 
that reducing damping delay significantly boosts stability even 
in the presence of fairly large stiffness delays. These results 
emphasize the significance of implementing damping terms at 
the fastest possible level (e.g. at the embedded level) while 
proportional (i.e. stiffness) servos can run in latency prone 
centralized processes. 

IV. Basis for Sensitivity Discrepancy 

In the previous section it was observed different behavior 
of the controller’s phase margin depending on the nature of 
delay. Damping delay seems to affect much more the system’s 
phase margin than stiffness delay. This section will analyze 
this physical phenomenon in much more detail and reveal the 
conditions under which this disparity occurs. 


A. Equations expressing phase margin sensitivity to delays 


Detailed mathematical analysis is developed to find further 
physical structure for the causes of stability discrepancies 
between damping and stiffness delays. Fet us re-visit the open 
loop transfer function of Equation The resulting open 
loop transfer function, including the low pass velocity filter 
of Equation Q, in the frequency domain (s = joS) is 


P0L{i^) 


jAi{uj) + A2 (uj) 
juj{jmu; + b){jTyUj + 1) ’ 


( 11 ) 


with 


Ai{uj) = Bujcos{Td uj) — K sin(Tg uj) + KryUt cos{TsU}), 

A2{uj) = Buj sin(rrf oj) K cos(Ts w) + sin(Tga;). 

( 12 ) 

Note that Euler’s Formula {e~P = cosa; — jsinx) has been 
used to obtain the above results. 

The phase margin, PM = 180° + ZPoLi^g), of the plant 


(111, where Z. is the angle of the argument, is 


PM = atan 


A 


ig 


LA 


2gJ 


-|-90°—atan 


m Wg 


—atan [TvWg], (13) 


with ujg being the gain crossover frequency ill and Aig = 

A^iu}g),i = {1,2}. 

Following the derivations of Appendix [A] one can obtain the 
sensitivity equations below expressing variations of the phase 
margin with respect to stiffness and damping delays, 

dPM _ + l) + KBujgM] ojg 


dT, 


A 2 . 


A 2 

^2g 


dPM + KBujgM] ujg 


dTd 


4 2 _1_ 4 2 
^Ig + ^2g 


where M = ^{TyUtg)^ + 1 • sin^(Ts - Td) ujg + 
derived in that Appendix 


(14) 


(15) 


is also 


B. Gain crossover sensitivity condition 


From the control analysis of the distributed plant performed 
in previous sections, increasing damping delays decreases the 
phase margin. This observation means that the sensitivity of 
the phase margin to damping delays must be negative, i.e. 


dPM 


< 0 . 


(16) 


Also from those analysis, it is observed that the phase margin 
is more sensitive to damping than to stiffness delays. This 
observation can be formulated as 


dPM ^ dPM 
dTd ^ dTs ■ 


(17) 


Fet us re-organize the numerator of Equation (0 to be 
written in the alternate form 


dPM [-Bujg + KM]Bujl 

W A^~+Ajg 


(18) 


An upper bound of the above equation occurs when the 
maximal condition sin( (Tg — Td) utg + 4>] = 1 is met, i.e. 


dPM 


< 


-BUJg + K^y^TyUJg)^ + 1 


BojI 


A 2 I A 2 
^Ig + ^2g 


(19) 


Based on the above inequality, ( [T6| ) is met if the following 
gain crossover sensitivity condition is met. 


UJg > 


K 

7i32 - iT2^2 • 


( 20 ) 


The above equation is only a sufficient condition for fulfilling 
Condition Obtaining a closed form solution for that 
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Fig. 5; Comparison of Step Response with Slow and Fast Damping Servos. The figures above compare the effects of 
implementing damping feedback on slow or fast servo processes. The simulations are performed on the same actuator used 
in the experimental section. Section [V] The top row depicts damping feedback implemented with delays of 15 ms while the 
bottom row depicts a faster damping servo with delay of only 1 ms. For both rows, various stiffness delays are identically 
used ranging from 5 ms to 25 ms. Subfigures (a) and (d) show simulations of the phase margin as a function of the natural 
frequency, which in turn is a function of the feedback stiffness gain. The first point to notice here is that the phase margin 
values for subfigure (a) are significantly lower than for (d) due to the larger damping delay. Secondly, both (a) and (d) show 


small variations between the curves, corroborating the small sensitivity to stiffness delays that will be studied in Section IV 


Corresponding step responses are shown along for various natural frequencies. The key observation here is that embedded 
damping greatly improves the stability of the controller despite large stiffness delays. 


condition would be very complex due to the presence of 
trigonometric terms. Therefore, the remainder of this section 
is to study under what circumstances Condition ( [20| l holds. 

At the same time. Inequality (17 1 can be re-written in the 
form 


dPM dPM _ + 1)] ujg 


dTa 


dT, 


A 2 I A 2 
^Ig + ^2g 


< 0 , ( 21 ) 


C. Servo breakdown gain rule 


\P0L{i^g)\ = 1 - 


( 22 ) 


Using the plant ( fTT) , it can be shown that the above equation 
results in the equality (see the Appendix[B|for the derivations). 


{BujgY + + 1) - 2KBujgM 


9 

= [{uJgmY + 6^) (t^ujI + l) . 


(23) 


where it has been subtracted the right hand sides of Equa¬ 
tions (HI and (0 for the derivation. Notice that in that 
subtraction the sine functions cancel out. Coincidentally, the 
above inequality is also met if the gain crossover sensitivity 
condition is fulfilled. In other words, that condition is 
sufficient to meet both Inequalities and ([T7|). 


The above equation is intractable in terms of deriving a 
closed loop expression of the gain crossover frequency. To 
tackle a solution our study introduces transformations of 
the parameters and numerically derives parameter ranges for 
which Condition ( p0] l holds. Let us start by creating a new 
variable that allows to write (20 1 as an equality. 


S G [—1, oo) s.t. Wg = (1 -f (5) 


K 




(24) 


To validate the gain crossover condition (201, our study 
solves for the gain crossover frequency, which consists of the 
frequency at which the magnitude of the open loop transfer 
function is equal to unity, i.e. 


Thus, demonstrating the gain crossover sensitivity condi¬ 
tion ( [20| is equivalent to demonstrating that 5 > 0. Rewriting 
Equation (j^ as AT = (B -f bY/4m and substituting K in the 
above equation, ([24| can be further expressed as 


= (! + <)) 


{B + bY 


y/lQB'^rrP — {B + bYr^ 


(25) 
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Dividing Equation (23 i by a new term U V, with U = 
TyUJg + 1, and V = while substituting Wg on the 

right hand side of Equatio n ([2J| by Equation ( [25] l, and using 
M as shown in Equation p7|i. Equation ([2^ becomes 


I I 2s\n({Ts - Td) ujg + 

V ViT^ 

_ {l + 6f{B + b)^ 

16 — B‘^{B + b)'^Tylm? 



Using Equation ( |2^ it can be further demonstrated that V = 
(TyOJg)'^ + (1 + 5)^7Thus U and V are only expressed in terms 
of (r^Wg)^. To further facilitate the analysis, let us introduce 
three more variables 


siny{Ts-Td)ujg-\-(l3j G[-1,1], 

(27) 

/3 G (0,00) s.t. 

B = 13 m, 

(28) 

7 G (0, c») s.t. 

B = 'yb. 

(29) 


Notice that a can be interpreted as an uncertainty, /3 is the 
ratio between damping gain and motor drive inertia and 7 is 
the ratio between damping gain and motor drive friction. Using 
these variables, (j2^ simplifies to 

^ 2 


U + V- 2aVU ■ V _ (1 + ^) (1+7)^ 


u-v 


16 7^ — (1 + 7' 


+ 4- (30) 


Using Equations (251, (281 and (291, the term [TyLOgf ap¬ 
pearing in the variables U and V on Equation ( [30| can be 
expressed as 


{TyWgf = 


(1+ <5)^(1+ 7)^ 


(31) 


167^ - (1 + 

Thus, Equation ( p0| ) does not contain direct dependencies with 
Wg and therefore can be represented as the nonlinear function 


/(a,/3,7,<5,r„) = 0 


(32) 


Let us demonstrate under which conditions <5 > 0, which 
will imply that Equation ( |20] l holds. In our lab, velocity filters 
with Ty — 0.0032 s are commonly used for achieving high 
performance control 1251 . and therefore Equation ( [30| will be 
solved for only that filter. Notice that it is not difficult to try 
new values of Ty when needed. Additionally, when sampling 
Equation ( |30| l for the values of a shown in Equation ( |Z7| i we 
observed that not only 5 is fairly invariant to a but the lowest 
value of 5 occurs for a = 1. These behaviors are omitted 
here for space purposes. Therefore, as a particular solution. 
Equation ( [30| is solved for the values 

/(a = l,/?,7,,5,T„ = 0.0032) = 0. (33) 


The above function is solved numerically and the solution 
surface is plotted in Eigure As it can be seen, (5 > 0 for 
7 > 2, allowing us to state that using a distributed PD feedback 
control law like the one in Eigure with the particular choice 
of the filter = 0.0032 s and with damping gains greater 
than 

(34) 


Range of 5 Solutions for Large 7 Range 



Surface area with 5 > 0 satisfying 
the condition w, = (1 + S) ^ 


Range of <5 Solutions for/small 7 Range 


Zero 5 contour line 


Eig. 6: Controller Values Meeting the Gain Crossover 
Sensitivity Condition. The surfaces above show the range of 
feedback parameters that meet the gain crossover sensitivity 
condition of Equation (20i. <5 > 0 represents the excess gain 
ratio by which the condition is met. 7 > 0 represents the 
ratio between damping feedback gain and passive damping. 
/? G [10,400] is chosen to cover a wide range of actuator 
parameters. The surfaces above demonstrate that a wide range 
of practical gains, 7, meet the aforementioned gain crossover 
sensitivity condition. The values of the above surfaces are 
solved by numerically identifying the smallest real root of 
Equation ( [30| . In the bottom right surface, it can be seen that 
(5 > 0 for 7 > 2, meaning that the gain crossover sensitivity 
condition is met if the ratio between damping feedback gain 
and passive damping is larger than two. 


causes the phase margin to be more sensitive to damping 
delays than to stiffness delays. The threshold above can 
therefore be interpreted as a breakdown gain rule which is 
sufficient to meet the gain crossover sensitivity condition (20i, 
and from which the aforementioned phase margin sensitivity 
discrepancy follows. 

This threshold hints towards a general rule for breaking 
controllers down into distributed servos, as was illustrated 
in Eigure Namely, if the maximum allowable feedback 
damping gain for a given servo rate is significantly larger 
than twice the passive actuator damping, then the controller’s 
stiffness servo can be decoupled from the damping servo to a 
slower computational process without hurting the controller’s 
stability. 


D. An example: analyzing real-world actuators by the servo 
breakdown rule 

As a means of demonstrating the utility of the breakdown 
gain rule of Equation (0, here we analyze several real- 
world actuation systems. Our goal is to determine whether 
the properties of each system make them good candidates 
for distributed control schemes with decoupled stiffness and 
damping feedback loops. 

Table shows actuator parameters for the Valkyrie hu¬ 
manoid and the UT-SEA actuator l28l . as well as the max¬ 
imum feedback damping gains that are implemented in those 


B > 2b, 



















TABLE I: UT-SEAA^alkyrie Actuator Parameters 


^/alkyrie Actuators 


Actuator 

Type 

output inertia 
m 

passive damping 
b 

damping gain 

B 

ratio 

7 

UT-SEA 

360 kg 

2200 N-s/m 

50434 N-s/m 

22.92 

Valkyrie 1 

270 kg 

10000 N-s/m 

46632 N-s/m 

4.66 

Valkyrie 2 

0.4 kg-m^ 

15 Nm-s/rad 

68 Nm-s/rad 

4.55 

Valkyrie 3 

1.2 kg-m^ 

35 Nm-s/rad 

196 Nm-s/rad 

5.60 

Valkyrie 4 

0.8 kg-m^ 

40 Nm-s/rad 

145 Nm-s/rad 

3.61 

Valkyrie 5 

2.3 kg-m^ 

50 Nm-s/rad 

360 Nm-s/rad 

7.20 

Valkyrie 6 

1.5 kg-m^ 

60 Nm-s/rad 

259 Nm-s/rad 

4.32 


actuators to achieve maximum impedance control. Our lab has 
been involved in developing these two sets of actuators. In all 
instances, the embedded servos had effective delays of 0.5 
ms. In order to compute the maximum feedback damping 
gains as a function of the previous servo rate, our recent 
work ||25]| is used. In that work, a new rule is provided to 
compute maximum feedback gains for a phase margin of 50° 
given the actuator parameters and the servo rate. Eigure 
shows, (1) pictures of various Valkyrie actuators, (2) a surface 
depicting the maximum allowable damping gains as a function 
of actuator parameters, and (3) Valkyrie’s actuators mapped 
into the surface. The surface is computed for effective delays 
of 0.5 ms. Within the surface, it shows the line corresponding 
to the breakdown gain rule of Equation ( [34| ). As can be seen, 
all actuators implement feedback damping gains that were 
above the breakdown gain boundary. It follows that those gains 
would be highly sensitive to damping servo delays. 

To maintain these maximum actuator gains, servo latency 
for the damping process must not be increased. However, 
according to the servo breakdown rule, the stiffness servo pro¬ 
cesses shall be fairly insensitive to delays and therefore could 
be decoupled and implemented in a slower centralized process. 
Such decoupling is advantageous in multi-axis robots where 
centralized processes contain sensor and model information 
needed for operational space control to coordinate the robot’s 
movement. In Subsection V-C we discuss such an application 
for an omnidirectional mobile robotic base. 


V. Experimental Evaluation 

The proposed controller of Eigure is implemented in our 
UT linear rigid actuator shown in Eigure]^ This linear pushrod 
actuator has an effective output inertia of m = 256 kg and 
an approximate passive damping of 6 = 1250 Ns/m. The 
sampling period is 0.5 ms, i.e., with a 2 kHz servo rate. At 
the same time, the controller is simulated by using the closed 
loop plant given in Equation Q. Identical parameters to the 
real actuator are used for the simulation, thus allowing us to 
compare both side by side. 


A. Step response implementation 

Eirst, a test is performed on the actuator evaluating the 
response to a step input on its position. The results are shown 
in the bottom part of Eigure |7] which shows and compares 
the performance of the real actuator versus the simulated 
closed loop controller. Various tests are performed for the same 
reference input with varying time delays. In particular large 



Maximum Allowable Damping Gains for Effective Delays of 0.5ms 



Eig. 8: Various Actuators Meeting Servo Breakdown Rule. 

The top image shows various actuators from NASA that our 
group helped to build. The bottom image shows the surface 
of maximum allowable damping gains (computed according 
to the gain rule described in ll25l l as a function of actuator 
parameters. 7 is the feedback damping gain ratio described in 
Equation (291, and m and b are the output inertia and passive 
damping of the various actuators. As it is shown, the maximum 
allowable gains are above the servo breakdown boundary. This 
entails that stiffness servos are fairly insensitive to delays and 
therefore can be decoupled from the damping servos when 
needed. 


and small delays are used for either or both the stiffness and 
damping loops. The four combinations of results are shown in 
the figure with delay values of 1 ms or 15 ms. 

The first thing to notice is that there is a good correlation 
between the real and the simulated results both for smooth 
and oscillatory behaviors. Small discrepancies are attributed 
to unmodelled static friction and the effect of unmodelled 
dynamics. More importantly, the experiment confirms the an¬ 
ticipated discrepancy in delay sensitivity between the stiffness 
and damping loops. Large servo delays on the stiffness servo, 
corresponding to subfigures (a) and (b) have small effects on 
the step response. On the other hand, large servo delays on 
the damping servo, corresponding to subfigures (c) and (d), 
strongly affect the stability of the controller. In fact, for (c) and 
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BLDC Motor 


Belt Drive 


Relative Encoder 


Encoder 


Motor. 


Pivots 


Ball Screw Pushrod 


(a) Ts = 1 ms, Td = 1 ms 


1.4- 


1.2 



(b) Ts = 15 ms, Td = 1 ms 


1.4r 




Time (seconds) 


(d) Ts = 15 ms, Td = 15 ms 



Fig. 7; Step Response Experiment with Distributed Controller. Subfigures (a) through (d) show various implementations on 
the UT linear rigid actuator corresponding to the simulations depicted on Figure Overlapped with the data plots, simulated 
replicas of the experiments are also shown to validate our models. The experiments not only confirm the higher sensitivity 
of the actuator to damping than to stiffness delays but also indicate a good correlation between the real actuator and the 
simulations. 


(d) the results corresponding to /„ = 12 Hz are omitted due 
to the actuator quickly becoming out of control. In contrast, 
the experiment in (b) can tolerate such high gains despite the 
large stiffness delay. 

B. Trajectory tracking with an uncertain load 

Performance limits are explored at their fullest in the test 
shown in Figure Here, an unmodelled weight of 4.5kg 
is attached to the load arm which is also connected to the 
pushrod actuator through a pivot. The weight is unmodelled 
and therefore constitutes a disturbance. By estimation, the 
total disturbance torque that the controller has to deal with 
is Fd = 16.84 Nm. A trajectory with output angle variations 
within [86°, 126°] is designed to test the controller’s perfor¬ 
mance under the load disturbance. This trajectory is inspired 
by that of a biped locomotion knee joint motion ll29l during 
fast walking, with angular velocities varying between ±2.5 
rad/s. 

This experiment tests the tracking performance under the 
load disturbance on both the real actuator and also on a 
numerical simulation of the controller model depicted in 
Figure Disturbance forces for the numerical simulation are 
applied based on the position of the arm and considering 
only gravitational effects. Judging from the visualization of 
the errors in that figure and the root mean square of the errors 
depicted in Table there is a good correlation between the 
real experiment and the simulation values for both the joint 
positions and angular velocities. 


TABLE II; Root Mean Square Tracking Errors 


Stiffness Delay 

Ts (ms) 

Experiment 

Simulation 

Position 
Eit (rad) 

Velocity 
Err (rad/s) 

Position 
Err (rad) 

Velocity 
En' (rad/s) 

2 

0.0182 

0.3866 

0.0204 

0.3970 

20 

0.0247 

0.6366 

0.0289 

0.6332 

30 

0.0360 

0.8753 

0.0386 

0.8178 


Once more, the test confirms the predicted robustness to 
stiffness delays that was studied in previous sections. Increas¬ 
ing 10 times Ts from 2 ms to 20 ms only increases the RMS 
joint position and angular velocity errors by less than two 
fold as shown in Table By using high gains, the controller 
ensures that joint tracking is accurate despite the large load 
disturbances. As shown in the previous table, the maximum 
root mean square (RMS) error for the tracked joint position is 
0.0182 rad « 1° for stiffness delays of Tg = 2 ms and 0.036 
rad « 2° for delays Ts = 30 ms. 

C. Distributed operational space control of a mobile base 

As a concept proof of our distributed architecture on a multi¬ 
axis mobile platform, a Cartesian space feedback operational 
space controller (OSC) OOl is implemented on an omnidi¬ 
rectional mobile base. The original feedback controller can be 
found in lljTI which was implemented as a centralized process 
with no distributed topology at the time. The mobile base 
is equipped with a centralized PC computer running Linux 
with the RTAI realtime kernel. The PC connects with three 
actuator processors embedded next to the wheel drivetrains 
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Fig. 9: Trajectory Tracking Experiment under Load Disturbances with Distributed Controller. The figures on the top 

row show snapshots of the testbed with an unmodelled load of 4.5 kg. The plots show trajectory tracking performance for a 
small damping delay, Td = 2 ms and various stiffness delays ranging from = 2 ms to Tg = 30 ms. Trajectory tracking 
errors on the bottom left remain relatively small despite the large stiffness delays, confirming the advantages of implementing 
damping feedback in a fast computational processes. A simulated experiment is also shown on the bottom right confirming 
good correlation between the real and simulated performance. 


via EtherCat serial communications. The embedded processors 
do not talk to each other. The high level centralize PC has a 
roundtrip latency to the actuators of 7ms due to process and 
bus communications, while the low level embedded processors 
have a servo rate of 0.5ms. Notice that 7ms is considered too 
slow for stiff feedback control. To accentuate even further the 
effect of feedback delay on the centralized PC, an additional 
15ms delay is artificially introduced by using a data buffer. 
Thus, the high level controller has a total of 22 ms feedback 
delay. 

An operational space controller (OSC) is implemented in 
the mobile base using two different architectures. First, the 
controller is implemented as a centralized process, which will 
be called COSC, with all feedback processes taking place 
in the slow centralized processor and none in the embedded 
processors. This implementation is the same as it was done for 
our previous work in EH. In this case, the maximum stiffness 
gains should be severely limited due to the effect of the large 
latencies. Second a distributed controller architecture is imple¬ 
mented inspired by the one proposed in Figure [^but adapted to 
our desired operational space controller, which will be called 
DOSC. In this version, the Cartesian stiffness feedback servo 
is implemented in the centralized PC in the same way than in 
COSC, but the Cartesian damping feedback servo is removed 
from the centralized process. Instead, our study implements 
damping feedback in joint space (i.e. proportional to the wheel 
velocities) on the embedded processors. A conceptual drawing 
of these architectures is shown in Figure The metric 
used for performance comparison is based on the maximum 
achievable Cartesian stiffness feedback gains, the Cartesian 
position tracking error, and the Cartesian velocity tracking 


error. To implement the Cartesian stiffness feedback processes 
in both architectures, the Cartesian positions and orientations 
of the mobile base on the ground are computed using wheel 
odometry and according to the methods discussed in ll3Tl . 

To achieve the highest stable stiffness gains, the following 
procedure is followed: (1) first, Cartesian stiffness gains are 
adjusted to zero while the damping gains in either Cartesian 
space (COSC) or joint space (DOSC) - depending on the 
controller architecture - are increased until the base starts vi¬ 
brating; (2) the Cartesian stiffness gains, on either architecture, 
are increased until the base starts vibrating or oscillating; (3) 
a desired Cartesian circular trajectory is commanded to the 
base and the position and velocity tracking performance are 
recorded. 

Based on these experiments, DOSC was able to attain a 
maximum Cartesian stiffness gain of 140N/(m kg) compared 
to 30N/(mkg) for COSC. This result means that the proposed 
distributed control architecture allowed the Cartesian feedback 
process to increase the stiffness gains by 4.7 times with 
respect to the centralized controller implementation. In terms 


of tracking performance, the results are shown in Figure 10 


Both Cartesian position and velocity tracking in DOSC are sig¬ 
nificantly more accurate. The proposed distributed architecture 
reduces Cartesian position root mean error between 62% and 
65% while the Cartesian velocity root mean error decreases 
between 45% and 67%. 


VI. Conclusions and Discussion 

The motivation for this paper has been to study the stability 
and performance of distributed controllers where stiffness and 
damping servos are implemented in distinct processors. These 
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(b) Distributed OSC Architecture 


(c) Centralized OSC Architecture 
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(d) Cartesian Trajectory Tracking 
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Fig. 10; Omnidirectional Mobile Base with and without Distributed Controller. In this experiment, we implement an 
operational space controller based on the work published in M- In that study, a Cartesian impedance controller is implemented 
in a monolithic centralized processor (see subhgure (c) for the schematic) limiting its high impedance capabilities. We re¬ 
implement that controller twice, hrst based on its original centralized form, COSC, and second based on the proposed distributed 
control architecture, DOSC, (see subhgure (b) for the schematic). The main difference between the two is that DOSC eliminates 
Cartesian damping feedback at the high level and instead implements joint space damping feedback at the embedded level. 
Due to the faster speeds of the embedded level, joint space damping feedback on the DOSC architecture can support higher 
impedances that are achievable with a COSC architecture. Subhgure (d) compares the Cartesian performance when the mobile 
base tracks a circle on the hoor. Subhgure (e) demonstrates that the Cartesian position tracking errors are signihcantly smaller 
for the DOSC architecture compared to COSC. Subhgure (f) demonstrates that the Cartesian velocity error is also smaller on 
DOSC compared to COSC. In all experiments wheel odometry is used for trajectory tracking and error calculations based on 
the work published in OTI . 


types of controllers will become important as computation 
and communications become increasingly more complex in 
human-centered robotic systems. The focus has been hrst on 
studying the physical performance of a simple distributed 
controller. Simplifying the controller allows us to explore the 
physical effects of time delays in greater detail. Then the 
proposed architecture has been leveraged to a mobile base 
system as a proof of concept. Our focus on this paper has been 
on high impedance behaviors. This focus contrasts with our 
previous work on low impedance control ||28]| . However, both 
high and low impedance behaviors are important in human- 
centered robotics. For instance, high impedance behaviors are 
important to attain good position tracking in the presence of 
unmodelled actuator dynamics or external disturbances. 

Using the phase margin frequency technique allowed us 


to reveal the severe effects of delays on the damping loop 
and appreciate the discrepancy with respect to the stiffness 
servo behavior. However, to reveal the physical reasons for 
this discrepancy, in-depth mathematical analysis is performed 
based on phase margin sensitivity to time delays. This analysis 
allowed us to derive the physical condition for the discrepancy 
between delays. Further analysis revealed that the previous 
condition is met for high impedance controllers, in which the 
damping feedback gain is significantly larger than the passive 
damping actuator value. To conhrm the observations and ana¬ 
lytical derivations, three experiments are performed by using 
an actuator and a mobile base. In particular, the results have 
shown that decoupling stiffness servos to slower centralized 
processes does not significantly decrease system stability. As 
such, stiffness servo can be used to implement operational 























































































12 


space controllers which require centralized information such 
as robot models and external sensors. 

The next step is to develop a similar study for controllers 
with an inner torque loop, such as those used for series elastic 
actuators Il28l . For this kind of actuators our interest lies in 
exploring both high and low impedance capabilities under 
latencies and using distributed control concepts similar to 
those explored in this paper. 


Appendix A 

Derivation of Equations <[I1 AND (HD 

Using the product differentiation rule on Equation ( [T4| , one 
obtains. 


Satan (Aig/A2g) _ 5atan(Aig/A2g) d{Aig/A 2 g) 

dTs ~ d{A^glA2g) ' dTs ' ^ ’ 

Using differentiation rules, the following applies, 

Satan fyAxgjA^g) ^ 1 

5(^lgM2g) l + (AlgM2g)^- ^ ^ 

Also, it is straightforward to derive, once again, using the 
product differentiation rule, the following equalities. 


S(Alg/A2g) _ SAlg 1 S(l/A2g) 


ST, 


ST, A2g ST, 




- A 2 g {Kijjg cos(T, Wg) + ATti, Wg sin(T, Wg)^ 
+ Aig [Kijjg sin(T, Wg) - Kr^ijpg cos(T, Wg)^ 


/12 

^2g 


- K^ijWg + 1) + KBi^g (sin ((T, 

TyiOgCOS ((T, T(^) ^g) ^ 


Td) OJg) 


which make use of the trigonometric rules cos^(x)+sin^(x) = 

1 and sin(a: — y) = sin(x) cos{y) — cos(x) sm{y). Gathering 
the above derivations and putting them together according to 
Equation ( [T5] l yields, 

Satan {Aig/A^g) _ [ — + 1) + KBujg M ] Wg 

“ ^?g+^ig 


with M = sin((T,-Td) -T^u;gCOs((T,-Td)a;gj. Using 
basic trigonometry, one can further simplify M to 

M = + 1 • sin((T, - Td) Wg + 4>) (37) 


where the phase shift cj) = atan(—r^Wg). The derivation of 
Equation ( [T5] l is very similar to the above and is therefore 
omitted for space purpose. □ 


Appendix B 

Derivation oe Equation ( [23| ) 

Using the gain crossover frequency of Equation ( [22] l on the 
numerator of Equation ([n) yields. 


IjAig + A2gp — A\g + A2g. 


TT^ina fhp PYnrpQcinn«2 


K + ^2g = (BoJgf + + 1) - 2KBugM, 

which also makes use of the trigonometric rules cos^(a::) + 
sin^(a;) = 1 and sin(x — y) = sin(x) cos{y) — cos{x) sin(j/). 
Combining the above norm of the numerator of Equation o 
with the norm of its denominator one gets 


|ToL(a;g)|^ 


(Twg)^ + _ 2KBLUg M 

((wwg)2 + 62^ ((T„a;g)2 + l) 


which is equivalent to Equation (231. 


= 1 , 

(39) 
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